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ABSTRACT 


The  proposed  attitude  control  system  addresses  three  major  problem 
areas : 

(1)  Operation  within  a high  torque  environment. 

(2)  The  preservation  of  vehicle  attitude  in  the  event  that  the  optical 
attitude  sensors  are  destroyed  by  external  means. 

(3)  Longevity,  the  need  for  the  vehicle  to  remain  operational  for 
periods  in  excess  of  seven  years. 

It  is  shown  that  for  a given  momentum  wheel  capacity,  orthogonal  triad 
torquing  will  allow  greater  growth  in  the  disturbance  torque  environment 
than  a biased  momentum  system.  Orthogonal  triad  torquing  is  therefore  to 
be  preferred  for  a general  purpose  platform  where  the  external  geometry  of 
the  vehicle  is  variable. 

Primary  attitude  sensing  is  accomplished  by  IR  earth  sensors  for  pitch 
and  roll,  and  processed  sun  elevation  information  for  yaw.  The  normal  opera- 
ting mode  uses  these  sensors  to  update  a redundant  inertial  unit  made  up 
of  six  SDF  gyros,  automatic  update  algorithms  are  suggested  designed  to  pre- 
vent a malfunctioning  optical  sensor  from  de-erecting  the  inertial  system. 

In  the  event  that  the  inertial  system  suffers  total  failure,  a backup 
mode  allows  the  optical  sensors  to  feed  the  control  system  directly.  The 
inability  of  the  sun  elevation  sensor  to  provide  yaw  information  for  short 
periods  centered  on  local  midnight  and  midday  means  that  the  yaw  channel 
must  operate  in  an  open  loop  mode  during  these  periods.  A small  pitch 
momentum  together  with  a compensating  roll-yaw  torque  couple  is  used  to 
stiffen  the  yaw  axis  during  these  1 coast 1 periods. 
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AN  ATTITUDE  CONTROL  SYSTEM  FOR  A LARGE 
GEOSYNCHRONOUS  EARTH-POINTING  SATELLITE 


1.  DISCUSSION 

The  term  large  in  this  instance  refers  to  a satellite  in  the  2000  to  3000 
lb.  class,  with  external  body  torque  in  excess  of  50  micro-ft . -lbs.  Two  of  the 
major  issues  to  be  considered  when  outlining  an  attitude  control  system  of 
this  type  are  torquing  methods  and  attitude  sensing.  In  the  case  of  torquing 
methods  the  control  system  may  be  classified  by  the  method  employed  to  control 
the  attitude  of  the  body  fixed  roll-yaw  plane.  If  the  system  relies  upon  a 
relatively  large  bias  momentum  to  resist  external  torques,  then  the  system, 
not  surprisingly,  is  categorized  as  a "biased  momentum"  system.  If  orthogonal 
triad  attitude  sensing  and  body  torquing  is  employed,  such  that  the  system 
does  not  rely  upon  a large  resident  momentum,  then  the  system  may  be  categor- 
ized as  "momentumless". 

Biased  momentum  systems  are,  in  general,  somewhat  simpler  in  that  correc- 
tional torques  need  be  produced  about  two  axes  only.  Also,  direct  yaw  sensing 
is  not  necessary.  However,  biased  momentum  systems  become  a little  unwieldy 
in  terms  of  bias  requirement  in  a high  torque  environment.  For  example,  if 
we  assume  the  simplest  case  where  the  momentum  bias  vector  is  normal  to  the 
orbit  plane,  and  forms  a constant  angle  with  the  body  fixed  axes  (i.e.,  rigidly 
mounted)  then  it  is  quite  straightforward  to  calculate  the  required  bias. 
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The  peak  level  and  the  assumed  form  for  the  torques  are  appropriate  for  a 
vehicle  such  as  ATS-F.  If  the  bias  vector  were  gimballed,  so  decoupling  the 
roll  and  yaw  errors,  then  yaw  pointing  becomes  our  criterion  and  some  relaxa- 
tion may  be  possible.  In  fact,  the  required  bias  is  a linear  ratio  of  permitted 
roll  to  yaw  error.  If  a yaw  error  of  0.6°  were  permitted  then  the  bias  require- 
ments would  reduce  to  330  ft-lb-secs. 

Both  of  these  methods  rely  upon  the  bias  momentum  being  very  large  compared 
to  the  accumulated  momentum  for  any  single  orbit,  such  that  the  vector  sum  pro- 
duces an  acceptably  small  error  angle.  Consequently,  having  chosen  a given 
bias,  any  further  increase  in  the  torque  environment  is  paid  for  directly  in 
reduced  pointing  accuracy,  or  increased  fuel  consumption. 

In  the  case  of  the  rigidly  mounted  wheel  the  required  bias  is  pushing  the 
frontiers  of  technology,  consequently  reliability  data  is  minimal  to  non- 
existent . 

In  the  case  of  the  gimballed  wheel  the  bias  is  less  breathtaking  but  still 
forty  times  greater  than  LES-8/9,  and  we  have  the  added  complication  of  the 
gimbal  mechanism,  whether  it  is  a second  wheel  or  a true  gimbal . 

The  "momentumless"  system  on  the  other  hand  requires  that  correctional 
torques  be  available  about  all  three  axes.  Furthermore,  attitude  sensing  is 
required  for  all  three  axes,  whereas  the  bias  system  requires  attitude  sensing 
about  two  axes  only.  However,  the  volatile  momentum  storage  requirements  are 
considerably  less  for  the  "momentumless"  system.  This  is  because  the  storage 
capacity  need  only  equal  the  peak  momentum  accumulations  for  any  orbit.  It  is 
quite  straightforward  to  calculate  the  required  storage  capacity  for  a "mom- 
entumless" system  assuming  the  same  torque  environment  as  above. 

Assuming  an  idealized  controller  and  zero  pointing  errors, 


T • sin  a)  t = h*  - h703 
o 2 3 o 


(5) 


2 


(6) 


h,,,  h,.  = roll  and  yaw  wheel  momentum  respectively 
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h0(pk)  = 3irT/2wo  = 2.6  ft-lb-secs. 
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h^(pk)  = 3.46  ft-lb-secs. 


(10) 


The  assumed  torque  would  in  practice  contain  several  harmonics  plus  a DC 
term,  particularly  during  the  solstice.  However,  this  is  not  an  attempt  to 
calculate  the  actual  requirements  of  a satellite,  but  simply  to  compare  the 
momentum  storage  needs  of  two  different  classes  of  control  system  when  exposed 
to  the  same  torque  environment.  It  is  clear  that  the  momentumless  configura- 
tion requires  much  less  storage  capacity  than  either  of  the  biased  systems, 
and  furthermore  the  attitude  errors  in  all  three  axes  can  be  zero,  whereas 
this  is  not  possible  with  the  biased  systems.  The  price  paid  for  this  is  the 
need  for  three  axis  torquing  and  attitude  sensing.  The  point  to  be  considered 
in  this  particular  discussion  is  the  uncertainty  of  the  torque  environment. 

We  are  considering  a control  system  suitable  for  a general-purpose 
vehicle,  hence  the  body  geometry  and  therefore  the  torques  must  be  considered 
as  unknown.  If  the  body  torques  increased  by  an  order  of  magnitude  above  those 
figures  mentioned,  then  the  biased  systems  would  be  totally  unfeasible  with 
present  technology,  whereas  the  storage  requirements  of  the  momentumless  sys- 
tem would  remain  relatively  modest  (<  30  ft-lb-secs)  and  well  inside  the 
proven  capabilities  of  the  industry. 

In  general,  the  momentumless  system  configuration  will  permit  operation 
within  the  maximum  torque  environment  for  a given  storage  capability.  The 
small  increase  in  complexity  brought  about  by  the  necessity  for  one  more 
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torquer,  plus  a small  amount  of  processing  in  order  to  derive  yaw  attitude, 
is  a small  price  to  pay  for  an  optimal  system  configuration. 

1 . 1 Body  Torquers 

In  order  to  provide  both  adequate  redundancy  and  margin  for  growth  in  the 
torque  environment,  a configuration  of  four  10  ft-lb-sec.  reaction  wheels  is 
proposed.  The  wheels  will  be  symmetrically  configured  about  the  three  principal 
axes  of  the  vehicle,  such  that  any  wheel  provides  components  of  torque  and 
momentum  about  all  three  axes.  Any  three  wheels  will  be  able  to  fulfill  the 
three  axes  torquing  requirement  of  the  momentumless  system.  The  fourth  wheel 
will  be  unpowered,  unless  a failure  occurs  in  one  of  the  active  wheels.  The 
configuration  is  shown  in  Fig.  1. 


+ Z 


Fig.  1.  Reaction  wheel  momentum  vectors. 

XYZ  represent  the  vehicle  principal  axes.  h.  represent  the  torquing  axes 
of  the  momentum  wheel. 

If  each  torquer  can  provide  equal  effort,  then: 
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Where  4>  represents  the  angle  made  by  the  wheel  spin  axis  with  respect  to 
the  body  fixed  principal  axes  of  the  vehicle. 

If  we  assume  the  right-hand  rule  sign  convention,  then  the  momentum  matrix 
would  be: 
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In  order  to  determine  net  momentum  about  any  principal  axis  the  individual 
wheel  momentums  are  measured  and  simply  plugged  in.  Inspection  of  the  above 
matrix  reveals  the  torquing  rules,  which  are  tabulated  below. 
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Thus,  this  configuration  is  very  simple  to  use  and  provides  very  signifi- 
cant redundancy,  in  that  any  wheel  may  fail  without  degrading  performance  in 
any  way. 

A further  point  is  that  the  Draper  Laboratory  TCP  treatment  of  ball 
bearings  appears  to  have  solved  the  touchdown  problem,  so  removing  reliability 
based  objections  to  reaction  wheels.  On  the  other  hand,  it  seems  clear  that 
reaction  wheels  would  be  very  much  more  efficient  in  terms  of  power  usage. 
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1 . 2 Attitude  Sensing 


The  decision  to  employ  the  momentumless  configuration  discussed  in  1.0 
implies  the  need  for  yaw  sensing. 

There  are  several  methods  of  doing  this.  With  an  equatorial  orbit  a 
strap-down 'star  tracker  viewing  Polaris  would  appear  to  be  a straightforward 
approach,  as  used  on  ATS-F.  However,  there  is  no  star  tracker  presently 
available  which  shows  any  indication  of  possessing  the  reliability  potential 
which  would  justify  its  use  on  a 7 to  10  year  mission.  ATS-F  is  a case  in 
point.  Solid  State  star  transit  sensors,  on  the  other  hand,  appear  to  be 
relatively  simple,  and  inherently  rugged.  There  are,  however,  several  objec- 
tions to  their  use.  Heretofor  they  have  been  used  at  high  transit  rates  (such 
as  on  the  DMS)  if  the  same  sensor  were  used  at  the  body  rates  appropriate  for 
a stabilized  geosynchronous  satellite,  the  signal-noise  ratio  would  be  marginal. 
Possibly  this  is  surmountable,  but  earth  rate  star  transit  sensors  are  not 
presently  available.  Furthermore,  an  on-board  star  map  would  be  required, 
together  with  an  inertial  memory  to  provide  attitude  data  between  star  updates. 
None  of  these  objections  are  very  serious,  but  there  seems  little  point  in 
pursuing  a discontinuous  system  based  on  a star  transit  sensor  when  the  sun 
is  readily  available  together  with  well  developed  sun  elevation  sensors  able 
to  provide  virtually  continuous  data.  It  is  proposed  therefore  that  a 360° 
sun  elevation  sensor  be  used  to  provide  yaw  sensing,  and  IR  earth  sensors 
similar  to  the  well  proven  TRW  scanning  type  used  to  provide  pitch  and  roll. 
Provided  that  the  orbit  is  known,  yaw  information  may  be  derived  from  the  sun 
elevation  sensor  over  a large  part  of  the  orbit.  The  two  periods  when  yaw 
derivation  is  not  possible  occur  at  local  midnight  and  midday.  The  former, 
because  of  sun  obscuration,  the  latter  due  to  kinemetic  reasons,  both  periods 
are  of  approximately  1 hour  in  duration.  It  should  be  possible  then  to  pro- 
vide three  axis  attitude  information  to  the  control  system  directly  from  the 
body  sensors  once  the  orbit  fit  data  is  transmitted  to  the  satellite.  This 
system  is  analyzed  later  in  this  note  (Section  2.0,  Backup  Mode).  However, 
while  the  "backup  mode"  is  able  to  fulfill  the  mission  in  terms  of  dynamic 
performance,  it  suffers  from  several  disadvantages.  The  first  and  major 
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disadvantage  is  that  the  optical  sensors  are  subject  to  damage  through  enemy 
action,  either  ground  based  or  via  killer  satellite.  If  this  occurred  the 
vehicle  would  lose  orientation  in  a very  short  time. 

Furthermore,  while  the  pitch  and  roll  IR  sensors  are  separate,  mutually 
redundant  items  referenced  to  the  earth,  the  yaw  sensor  has  no  redundancy,  and 
is  referenced  to  ground  derived  orbit  fit  data.  What  is  required  is  a second 
yaw  sensor,  both  to  provide  redundancy  and  a mutual  operational  check. 

Gyroscopes  overcome  both  of  these  disadvantages.  A gyro  triad  updated 
from  the  three  axis  body  sensor  would  provide  sufficient  inertial  memory  to 
preserve  satellite  attitude  within  acceptable  limits  for  several  months  following 
an  optical  sensor  wipeout.  In  the  event  that  the  sun  elevation  sensor  failed, 
or  a gross  operational  check  was  required,  the  gyros  could  be  reconnected  by 
ground  command  into  the  gyro-compassing  mode.  This  mode  has  the  advantage 
that  it  is  self  erecting,  and  does  not  require  orbital  data.  Both  of  these 
gyro  based  systems  are  discussed  in  greater  detail  in  Section  3.0. 

As  an  overview,  it  is  proposed  that  the  normal  operational  system  derive 
attitude  data  from  a rate  gyro  triad.  The  gyros  will  be  erected  and  updated 
as  required  by  a three  axis  body  sensor  which  will  consist  of  IR  earth  sensors 
for  pitch  and  roll  and  a sun  elevation  sensor  plus  microprocessor  for  yaw. 

As  an  almost  equal  performance  alternate  to  this  configuration  the  gyros  and 
earth  sensors  may  be  connected  as  an  orbital  gyrocompass. 

In  the  event  that  the  gyro  system  suffers  catastrophic  failure,  the  control 
system  may  enter  the  "backup  mode",  in  which  the  optical  sensors  bypass  the 
gyros  and  supply  the  control  loop  directly. 

2 . BACKUP  MODE 

The  "backup  system"  is  intended  to  become  operational  in  the  mathemati- 
cally unlikely  event  that  the  gyro  package  suffers  total  failure.  If  this 
occurs,  the  pitch,  roll  and  yaw  body  sensor  outputs  will  bypass  the  gyro  package 
and  feed  the  control  system  directly.  However,  the  yaw  sensor,  as  mentioned 
previously,  cannot  operate  throughout  the  orbit.  For  approximately  one  hour 
centered  on  local  midnight  the  sun  is  obscured.  Also,  if  the  sun  elevation 
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angle  is  zero,  then  yaw  cannot  be  measured  at  local  midday  for  kinemetic 
reasons,  even  for  a non-zero  elevation  angle  the  sun  elevation  sensor  becomes 
progressively  less  sensitive  to  yaw  motion  as  local  midday  is  approached. 

It  is  proposed  then  to  deactivate  the  yaw  sensor  for  approximately  one  hour 
centered  about  local  midnight  and  local  midday.  The  satellite  will  "coast" 
through  these  periods  with  active  pitch  and  roll  control  only.  In  order  to 
make  the  satellite  appropriately  stiff  during  these  "coast"  periods,  the 
"backup  mode"  will  operate  with  a relatively  small  momentum  vector  aligned 
with  the  pitch  axis.  It  is  interesting  to  note  at  this  point  that  in  order 
for  the  pitch  momentum  vector  to  be  effective  in  providing  yaw  stiffness  it 
is  necessary  to  effect  a torque  coupling  between  the  roll  and  yaw  axes.  In 
other  words,  the  situation  which  exists  during  the  coast  period  is  as  follows: 
pitch  and  roll  loops  and  sensors  remain  active,  the  yaw  sensor  is  deactivated, 
external  body  torques  are  occurring  naturally  about  all  three  axes.  If  under 
these  circumstances  a body  fixed  momentum  vector  is  aligned  with  the  pitch 
axis  in  an  attempt  to  provide  yaw  stiffness,  its  effect  will  be  almost  totally 
nullified  by  the  operation  of  the  roll  loop.  In  fact,  the  body  motion  about 
the  yaw  axis  will  be  governed  only  by  the  moment  of  inertia,  with  the  momentum 
vector  playing  no  part.  This  is  shown  below. 
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2 . 1 Equations  of  Motion  For  a Zero  Momentum  Satellite 
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T j = resultant  axial  torque  for  j channel  and  represents  the  difference 
between  external  disturbance  torque  and  system  control  torque. 

• t.  = Tn . - h.  = Tn . - G . ..  • E. 

* * 3 Dj  3 Dj  (])  3 


where  G...  represents  the  gain  and  shaping,  and  E.  represents  the 
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. th 


euler  error  angle  for  the  j channel. 


h.  = The  resultant  principal  axis  angular  momentum  contained  by  the 
reaction  wheels. 

Equations  (15)  and  (16)  are  solved  below  for  E^/T^,  the  yaw  error  angle- 
yaw  disturbance  torque  transfer  function  for  the  coast  period,  when 

C'(3)  E3  = °* 


Assuming  pitch  to  be  effectively  decoupled  from  the  roll-yaw  plane 

(Ej  - 0). 
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P = Laplace  Operator 

Jj=  moment  of  inertia  of  the  axis. 


represents  the  gain  and  shaping  of  the  roll  channel,  and  is 
therefore  a design  parameter.  If  we  assume  typical  values  for  J0,  J^,  and 
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This  will  be  recognized  as  the  torque-inertia  balance  expression  for  an 
unrestrained  system. 

Despite  the  simplications , it  is  clear  that  the  pitch  axis  momentum 
vector  plays  very  little  part  in  providing  stiffness  about  the  yaw  axis. 
Clearly  the  operation  of  a ’tight1  roll  loop  is  producing  torque  about  the 
yaw  axis,  this  phenomenon  is  analyzed  in  2.1.1. 

2.1.1  Roll-Yaw  Compensation 


Referring  to  equations  (15)  and  (16),  the  roll  and  yaw  equations  of 
motion  respectively  at  t = 0. 


Let  us  set  up  the  following  conditions 

(1)  Roll  loop  continuously  closed.  (En  — 0) 

(2)  Yaw  loop  open. 


(3)  Torque  applied  about  the  yaw  axis  at  t = 0. 


At  t = 0 therefore  = E_  = 0. 


T2  = J2E2  - h3Wo 


= Tj  - - h9u)Q  + = total  reactive  torque. 
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T3  * TD3  - S3  * TD3  * T3C*  Where  T3C  = yaw  contro1  t°rque- 


If  the  total  reactive  torque  about  yaw  is  to  be  minimized,  then  the  yaw  axis 
must  be  open  loop  torqued  by  T^: 


T_~  = -h9to  - 
3C  2 o 


2 

Ou  T-  -w  h_  h.T0  h.h.w 
~ 2 0 3 2_  + 1 3 o 


j2p 


j9p 


X2  TD2  ' G (2) 


-w 


3C 


w “h- 

f CTD2  - G(2)E2^  - -V  - h2Wo 


h.  h.h  u 

(TD2  - G(2)E2)  + -ifr 


(18) 


represents  the  torque  which  must  be  applied  to  the  yaw  axis  during  the 
coast  period  in  order  to  minimize  the  roll-yaw  coupling.  Notice  that  two 
terms  are  proportional  to  the  integral  of  net  roll  axis  torque,  suggesting 
the  need  to  know  something  about  the  roll  disturbance  torque  during  the 
coast  period.  The  terms  in  which  contain  h^  clearly  spring  from  the 

momentum  cross  product  term  in  the  roll  equation  of  motion.  This  would  more 
easily  be  nulled  by  torquing  the  roll  axis.  The  compensating  torques  for 
roll  and  yaw  are  shown  below.  They  would  be  calculated  on  a continuous  basis 
and  applied  directly  to  the  body  torquing  mechanism. 


Roll  Compensation:  -h^coQE9  + h^  • 


(19) 


-h„w  - 
2 o 


00  Tn-> 

o D2 


^oG (2) E2 


hlTD2 

J2P 


hlG(2)E2 


•V 


Yaw  Compensation: 


P 


P 


(20) 


T 2 in  (20)  above  is  a measured  roll  disturbance  torque,  in  order  to 
track  it  we  will  designate  it 

Inserting  these  compensation  terms  into  the  general  equations  of 
motion  we  obtain: 


Let  J,  = for  arithmetic  convenience. 


T = J-,E~  - J-U>  E_  + h.E_  + • E0 

D2  22  2o3  13  (2)  2 


T = J.E,  + J-u  E.  - (J_  - J,)w  E_  - h.E  + h to  E_ 
D3  2o2  v 2 1'  o 3 12  lo3 


-to  Tn_n  to  G._.E_  h T h.Gr_.E_ 

o D2Q  + o (2)  2 1 D20  1 (2)  2 

P P J2P  " J2P 


Making  similar  assumptions  and  simplications  as  before  we  obtain: 


E /T  ^ = — • 
5 03  J3 


1 


2 hl 
P + 


J2J3 


Taking  the  inverse  transform: 


TD3  • J2 


•3(t) 


1 - cos  (h ^ / ^J2J^)t 


(21) 


(22) 


The  satellite  would  therefore  nutate  at  rads/sec.  with  a 

peak  deviation  of  2Tp^J,/hj‘  radians. 

In  this  case  the  pitch  momentum  vector  (h^)  does  provide  stiffness  to 
yaw  body  torques,  the  fact  that  nutation  occurs  during  the  coast  period  is 
probably  not  important  providing  the  excursion  is  within  the  system 
pointing  tolerance. 
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The  effect  of  roll  body  torque  on  yaw  attitude  when  the  system  is  thus 
compensated  is  shown  below: 


3(P) 


(TD2  TD20')hlG(2) 


2 G(2)  2 ^1 

(P^  + -4£I)(P  ♦ 


J2J3; 


Equation  (23)  reveals  the  fact  that  when  compensated  in  this  manner,  the 
yaw  axis  is  somewhat  sensitive  to  the  difference  between  actual  roll  body 
torque  (T^,,)  and  estimated  body  torque  (Tp^^).  This  means  that  the  compen- 
sation scheme  must  be  tailored  to  the  disturbance  torques  which  pertain 
during  the  coast  period.  For  example,  if  we  consider  the  body  torque  forms 
described  by  Eqs.  (1)  and  (2),  we  see  that  the  yaw  torque  during  the  midday 
coast  period  is  quite  high  and  changing  rapidly,  potentially  difficult  to 
predict,  the  roll  torque  on  the  other  hand  is  close  to  its  maximum  value 
and  changes  very  little  during  the  coast  period.  This  is  the  kind  of 
situation  where  the  form  of  compensation  described  by  Eq.  (19)  and  (20) 
would  work  very  well.  It  would  only  be  necessary  to  measure  h*  immediately 
prior  to  the  coast  period  and  plug  it  into  the  compensators.  The  body  torques 
predicted  for  LES-10  indicate  that  yaw  torque  will  approach  zero,  while  roll 
torque  will  be  almost  constant.  In  this  situation  it  would  not  be  appropri- 
ate to  include  all  the  compensation  terms  described  in  Eq.  (20),  in  fact 
-h20L>o  would  be  the  only  relevant  term,  with  zero  pitch  bias. 

The  required  roll-yaw  compensation  is  inestricably  coupled  to  the 
form  and  magnitudes  of  the  roll-yaw  body  torques,  the  principal  axis  moments 
of  inertia,  together  with  the  actual  coasting  period.  However,  available 
evidence  would  indicate  that  providing  a measurement  of  hi,  is  taken  immed- 
iately prior  to  the  coast  period,  some  version  of  Eqs.  (19)  and  (20)  will 
cover  the  roll -yaw  compensation  requirements. 
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2.1.2. 


Computer  Model 

In  order  to  illustrate  the  foregoing  analysis  a linear 


ized  three  axis  computer  model  was  constructed  on  the  IBM-370  using  an  exist- 
ing numerical  integration  routine.  The  system  equations  of  motion  are  shown 
below.  No  particular  effort  was  expended  on  the  loop  design  other  than  to 
assure  stability.  Apart  from  the  torque  compensation  terms  already  dis- 
cussed, the  loop  shaping  in  each  case  is  on  integral  plus  proportional 
network,  feeding  a velocity  loop  to  control  wheel  speed. 


(24) 


+ h..E,  + h..w  E_  - h_F.  - h_w 
13  lo2  3 1 3o 


(25) 


+ h_E  + h_w  - h,E0  + h..a)  E7 
21  2o  12  lo3 


(26) 


Pitch  Compensation: 


+h~w  E_ 

2 o 2 


Roll  Compensation: 


-h,to  F.»  + h,w 
1 o 2 3 o 


Yaw  Compensation  (1): 


Yaw  Compensation  (2) : 
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The  compensation  terms  are  added  to  the  right  side  of  system  Eqs . 

(24),  (25),  and  (26).  The  principal  moments  of  inertia  are  based  on  mass 
properties  calculation  for  one  version  of  the  projected  satellite. 

J1  = J2  = J3  = 2,800  slug  - ft2 

= 280  ft.  lbs/radian/sec. 

= 28  ft.  lbs/radian 

The  program  listing,  appropriately  commented,  is  shown  in  the  Appendix. 
Figure  2 illustrates  the  conclusion  that  an  unaided  pitch  momentum  is 
unable  to  provide  yaw  stiffness  in  the  presence  of  a tight  roll  loop. 

Figure  3 illustrates  the  effectiveness  of  the  compensation  scheme. 

Conditions 

Pitch:  Loop  closed,  compensated* h^  = 10  ft-lb-secs. 

Zero  disturbance  torque. 

Roll:  Loop  closed,  compensated.  50y-ft-lbs  disturbance 

torque  throughout.  h*  — h^co^  measured  at  coast 
period  inception  (11.30  hrs  local  time). 

Yaw:  Loop  open,  compensators  (1)  and  (2) . lOy-ft-lbs 

disturbance  torque  throughout. 

Figure  4 illustrates  the  effectiveness  of  the  compensation  scheme  in  the 
presence  of  the  realistic  body  torques  described  by  Eqs.  (1)  and  (2). 

Conditions  (3) 

Pitch:  Loop  closed,  compensated,  h^  = 5 ft-lb-secs. 

50y-ft-lbs  disturbance  torque  throughout. 

Roll:  Loop  closed,  compensated,  disturbance  torque  = 

50  x 10  ^ sin  a)  t ft-lbs,  h*  — h~o)  measured  at 
o 2 3 o 

coast  period  inception  (11.30  hrs.  local  time). 
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Yaw: 


Loop  open,  compensators  (1)  and  (2) , disturbance 
torque  = 50  x 10  ^ cos  co  t ft-lbs. 
to  = 0600  hrs.  local  time 

Figure  5 shows  the  effect  of  the  disturbance  torques  calculated  for  the 
current  LES-10  configuration.  These  torques  are  such  that  partial  yaw  comp- 
ensation is  appropriate. 

Conditions  (1) 

Pitch:  Loop  closed,  compensated,  disturbance  torque  = 

40  x 10  ^ sin  a)  t ft-lbs.  h,  = 0 (initial  value) 
o i 

Roll:  Loop  closed,  compensated,  disturbance  torque  = 

-12  x 10-6  ft-lbs. 

Yaw:  Loop  open,  compensator  (1)  only.  Zero  disturbance 

torque. 

Condition  (2) 

As  for  condition  (1),  with  all  channels  uncompensated. 

to  = 0600  hrs.  local  time 

Coast  inception  11.30  hrs.  local  time 

Figure  6 illustrates  the  major  torque  inputs  for  all  three  channels  when 
fully  compensated. 
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YAW  ERROR  { DEGS ) 


| TN  77-30(2)  j 


COAST  PERIOD  (MINUTES) 


>► 


Fig.  2.  Uncompensated  yaw  axis  response  to  a disturbance  torque. 
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YAW  ERROR  (DEGS) 


TN  77-30(7)  ] 


Fig.  3.  Fully  compensated  yaw  axis  response  to  a disturbance  torque. 
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YAW  ERROR  (PEGS) 
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♦0  5 
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0 


-0,1 
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Fig.  4.  Comparison  of  a compensated  and  uncompensated  yaw  axis  response  to 
typical  disturbance  torques. 
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YAW  ERROR  (DEGS) 


TN  77-30(5) 


Fig.  5.  Comparison  of  a compensated  and  uncompensated  yaw  axis  response  to  a 
roll  disturbance  torque. 
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TN  77-30(6) 


- h*  (jj  o E t 


YAW 

Fig.  6.  Fully  compensated  axial  torques  during  the  coast  period. 
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3.  INERTIAL  SYSTEM 


It  is  proposed  that  the  inertial  system,  in  either  of  its  two  basic  con- 
figurations, form  the  normal  or  operational  mode  of  the  attitude  control  system. 
The  "backup  mode"  described  earlier  will  be  used  only  in  the  event  of  a cata- 
strophic failure  in  the  inertial  unit. 

3 . 1 Inertial  Unit 

WTien  considering  an  inertial  system  with  a projected  life  of  5 to  7 years, 
the  reliability  of  the  gyro  instrument  becomes  the  dominant  question.  Gyros 
have  not,  as  yet,  been  applied  to  extended  missions  of  this  type  in  any  quan- 
tity. Consequently,  end-of-life  failure  mechanisms  have  not,  in  general,  been 
established.  While  theoretical  MTBF  is  quoted  in  the  millions  of  hours, 
established  MTBF  based  on  actual  performance  is,  for  obvious  reasons,  an  order 
of  magnitude  less,  and  is  in  terms  of  instrument  hours.  If  gyros  are  to  have 
any  credence  for  a mission  such  as  this,  considerable  redundancy  will  be 
required.  It  is  therefore  proposed  that  the  inertial  unit  be  based  on  the 
configuration  suggested  by  Gilmore  and  McKern  of  CSDL  in  a 1970  AIAA  paper 
In  this  arrangement  geometric  redundancy  is  achieved  by  using  a non-orthogona 1 
mounting  configuration  in  which  instrument  input  axes  are  oriented  to  corres- 
pond to  the  array  of  normals  to  the  faces  of  a dodecahedron.  This  is  shown 
in  Fig.  7. 


Fig.  7.  Gyro  axes  with  respect  to  a regular  dodecahedron. 
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This  arrangement  yields  a unique  symmetry  in  which  all  instrument  lA?s 
are  at  a spherical  angle  of  2<J)  from  each  other. 

(p  = 31°  48 f 2.8" 

The  matrix  relating  the  gyro  axes  and  the  vehicle  principal  axes  is  shown 
below. 


“a" 

sin  (p  0 cos  (p 

“b 

-sin  (p  0 cos  (J) 

“x 

“c 

cos  (j)  sin  (p  0 

“d 

cos  <p  -sin  ((>  0 

wz 

“e 

0 cos  < p sin  (p 

“f 

0 cos  <p  -sin  (p 

(27) 


It  is  clear  from  this  relationship  that  any  three  gyros  are  able  to  supply 
rate  information  about  all  three  vehicle  axes.  It  is  proposed,  therefore, 
that  six  SDF  gyros,  each  with  an  independent  set  of  electronics,  be  arranged 
in  the  hexad  shown  in  Fig.  2.  The  selection  of  the  gyro  instrument  is  dif- 
ficult, however,  if  we  ignore  for  the  present  the  TGG  and  the  ESG,  both  of 
which  show  great  promise,  the  most  mature  and  documented  inertial  grade  gyro 
available  is  the  Northrop  G1-K7G.  This  has  a theoretical  MTBF  of  3 x 10^  hrs, 
and  an  established  instrument-hours  MTBF  of  3.4  x 10^  hrs  (39  yrs) . If  we 
use  the  established  MTBF  and  a projected  system  life  of  61,320  hrs  (7  yrs)  the 
"all-live"  hexad  reliability  equation  gives  us  the  probability  of  system 

• i (4) 

survival. 


d .on  / c -4At  -5At  -6At 

R = +20e  — 45e  + 36e  — lOe 


At  = system  life/gyro  MTBF  = 0.18 

R = 0.99122 


(28) 
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This  shows  a greater  than  99%  chance  of  system  survival  over  a 7-yr 
period.  Survival  is  defined  as  any  three  instruments  in  operation.  Further- 
more, the  above  reliability  equation  assumes  all  six  gyros  are  operating,  if 
three  are  closed  down  until  a failure  occurs  in  one  of  the  three  operational 
instruments,  then  reliability  is  increased. 

3 . 2 Inert ial  Sensor  (1) 


It  is  proposed  that  the  following  configuration  be  the  normal  day-day 
sensing  system.  It  is  felt  that  this  configuration  will  cope  adequately  with 
a high  gyro  drift  rate,  and  providing  the  updating  algorithm  is  carefully 
chosen,  will  survive  an  optical  sensor  wipeout. 


is  a nonlinear  combination  of  three  drift  rates,  and  consequently 
has  a greater  variance  than  any  single  instrument.  However,  with 
the  rates  we  are  concerned  with  this  is  not  significant. 

The  equations  of  motion  for  this  system  are  given  below  (for  the  update 
loops  closed) . 


(Kx  + Bl  Jdt)  (E1 
(k2  + b2  Jdt)  (E2 
(K3  + B3  Jdt)  (E3 


n - E10}  + Ei  + V 

n “ E20}  + E2  - U)oE3 

n — Eq  ) + E0  + u)  E0 
3o  3 o 2 


= E10 

+ CO  E0  + 

o 3o 

^D2 

E20 

# 

— CO  E_  + 
o 2o 

^D3  = 

E3o 

Solving  these  equations  is  straightforward  if  somewhat  laborious;  the  results 
are  shown  below. 

(K  P + B )n  P2<j) 

P = P 4-  = _ 

10  1 A1(P)  A1(P) 

2 

A1(P)  = P + PKj  + Bl 


"20 


E2  + 


[KP3  + (K„K_+B -+u)  K_)  P"  + (K„B_+B„K_+u)  B_)  P + B.B.J  n 
2 3 2 o 3 2 3 2 3 o 3 2 3 

A23(P) 

[P4  + K3P>  + *D2  + “op3+D3 


23  (P) 
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Fig.  8.  Inertial  system  (1). 
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E30  E3  + 


+ 


[K„P3  + (K_K,+B,-u>  K_)  P2  + (K-B.+K-B.-w  B.)  P + B-B-]  n 

J Z J J O Z Z Z Z J Q Z Z J 

A23(P) 

[p4  + k2p3  + b2p2]  ^ - Mop\2 
A23(p) 


A23(P)  = [I>4  + (K2+K3)  pJ  + (B3+B2+K2K3+Wo2)  p2  + (K2K3+B2K3)  P + B2B3] 


Notice  that  the  system  is  self  erecting  in  that  in  the  absence  of  optical 
sensor  noise  and  gyro  drift  terms,  the  error  integrator  output  is  equal  to 
the  euler  angle.  Notice  also  that  gyro  drift  rate  ((j)^)  is  not  present  at 
the  integrator  output,  indicating  that  gyro  drift  rate  will  not  produce 
vehicle  attitude  errors,  derivatives  of  drift  rate  will.  However,  the  mag- 
nitude of  rate  derivative  terms  is  likely  to  be  very  small.  A further  point 
of  interest  is  that  the  optical  sensor  noise  term  (n)  will  be  operated  on  by 
a low-pass  filter  before  appearing  at  the  error  integrator  output.  It  seems 
clear  that  by  suitable  choice  of  loop  constant  (K&B)  the  control  system  can 
be  effectively  insulated  from  sensor  noise  during  the  update  period. 

The  update  algorithm  is  vital  to  the  success  of  this  system  and  will  be 
discussed  in  a later  section.  It  is  not  unreasonable  to  expect,  however,  that 
the  update  loop  will  be  open  most  of  the  time. 


3 . 3 Inertial  Sensor  (2) 

Inertial  system  (1)  discussed  in  3.2  suffers  from  one  slight  disadvantage. 
If  the  optical  sensors  are  indeed  measuring  the  true  Euler  angles,  then  the 
system  will  self  erect.  However,  the  yaw  error  is  derived  from  the  sun  ele- 
vation sensor  based  on  a knowledge  of  the  orbit  parameters  and  the  on-board 
solutions  of  several  nonlinear  equations.  As  a check  on  this  fairly  complex 
procedure  it  would  be  convenient  to  have  available  a second  method  of  meas- 
uring yaw.  Gyrocompassing  supplies  this  method  providing  the  composite  drift 


27 


rate  associated  with  the  roll  channel  body  rate  measurement  is  < 0.02° /hr. 

It  is  suggested  therefore  that  gyrocompassing  form  an  alternate  method  of  using 
the  rate  information  produced  by  the  gyro  hexad.  The  method  of  connection  is 
shown  in  Fig.  9. 

When  comparing  this  configuration  with  inertial  system  (1)  described  in 
Section  3.2,  there  are  clearly  three  major  changes.  The  most  obvious  is  the 
fact  that  both  yaw  and  roll  are  erected  by  the  roll  optical  sensor.  This  is 
inherent  to  orbital  gyro-compassing,  in  which  the  roll  sensor  provides  the 
necessary  vertical  reference  for  yaw.  Secondly  the  integrator  is  no  longer 
present  in  the  roll  optical  sensor  channel.  This  is  because  in  the  orbital 
gyro-compass  configuration  the  integrator  is  no  longer  beneficial  and  does 
not  cancel  drift  rate.  The  major  yaw  error  source  is  the  gyro  drift  rate 

associated  with  the  roll  body  rate  measurement.  With  the  hexad  configuration 
the  drift  term  will  depend  upon  which  three  gyros  are  in  use.  When  using 
inertial  system  (1)  this  is  not  important  because  the  roll  optical  sensor 
integrator  will  absorb  whatever  drift  term  is  produced;  however,  with  the 
gyro-compass  configuration  (inertial  system  (2))  this  is  not  true.  The 
drift  term  must  either  be  known  and  programmed  in  from  the  ground,  or  we 
must  trust  the  yaw  optical  sensor,  in  which  case  we  simply  disconnect  the 
input  of  the  roll  optical  sensor  integrator  when  transferring  from  inertial 
system  (1).  This  situation  is  unlikely  to  produce  any  difficulty,  in  order 
to  cover  360°  in  pitch  we  will  have  four  separate  sun  elevation  sensors,  in 
extremis  it  would  be  a trivial  matter  to  derive  roll  gyro  drift  rate  bias  from 
any  of  these. 

The  equations  of  motion  for  inertial  system  (2)  (Fig.  9)  are  shown  below 
(update  mode) . 

To  make  the  point  regarding  drift  bias  cancellation  quite  clear,  we  will 
assume  in  the  following  analysis  that  all  three  channels  include  an  integral 
plus  proportional  network  in  series  with  the  optical  sensor.  That  is,  refer- 
ring to  Fig.  9,  the  box  containing  only  will  be  assumed  to  contain 
K2  + B2  / dt. 
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Fig.  9.  Inertial  system  (2)  (Gyro-compass). 
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(K1+B1  / dt)  (E1+n-E1())  + E1  + <J»D1  - 

(K2+B2  $ dt)  (E2+n_E20)  + E2  _ WoE3  + “oE30  + ^D2  “ ^DC  = E20 

^K3+B3  f dt^  ^E2+n_E20'>  + E3  + WoE2  _ WoE20  + ^D3  = E30 

Once  again  the  solution  of  these  equations  is  simple,  if  incredibly  laborious. 
The  pitch  equation  is  identical  with  inertial  system  (1),  therefore  we  will 
ignore  it. 


E 


E 


20 


30 


[K2P2  + <B2+u.oK2)  P + wBj]  n wP2^  + P3(*d2-*dc) 

e2  + aTT + XT, 


(P) 


(p) 


[K-P2  + (B,-w  K_)  P - u B_  ] n [P3  + K„P2  + B_P]  <|>n, 
_ , J j o Z oz,  Z Z DJ 

E3  + + A? 


(P) 


(P) 


[p  (k3+wo)  + B3P]  (4>dc-4>d2) 

A?p) 


P3  + K„P2  + (B-+K,u  +(/)  P + 0)  B_ 
2 2 3 o o o 3 


Notice  that  despite  the  lack  of  an  optical  yaw  sensor  the  system  is  self 
erecting,  such  that  in  the  absence  of  optical  sensor  noise  and  gyro  drift 
terms  the  error  integrator  outputs  are  equal  to  the  Euler  angles.  Notice 
also  that  the  optical  sensor  noise  term  (n)  is  filtered  before  appearing  on 
the  error  integrator  output.  As  in  the  case  of  inertial  system  (1),  with 
proper  selection  of  loop  constants  (K&B)  the  control  system  would  receive 
a very  quiet  error  signal.  The  behavior  of  the  composite  gyro  drift  term  is 
interesting,  in  order  to  make  this  clear  let  us  assume  that  the  cancelling 
term  (f)  = 0.  In  the  case  of  the  roll  channel  both  roll  and  yaw  drift  terms 

are  present  but  in  a rate  derivative  form,  therefore  drift  rate  does  not 
contribute  in  any  way  to  roll  error. 
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In  the  case  of  yaw,  if  we  let  the  rate  derivative  terms  approach  zero, 
and  solve  for  the  yaw  end  value,  ignoring  sensor  noise  (n)  . 

B„ 


J30(S.S.) 


E3  + B„ 


^D3  ^D2 


(1) 


(1) 


In  this  case  the  optical  sensor  integrators  have  not  cancelled  the  drift 
rate  term  as  they  did  for  pitch  and  roll.  In  fact  they  have  increased  the 
variance.  It  seems  that  we  can  only  benefit  by  letting  (3^  = 0,  that  is  by 
removing  the  optical  sensor  integrator  in  the  roll  channel,  as  shown  in 
Fig.  9.  if  We  therefore  let 


^D2  ^DC 


e2  = o 

The  expressions  for  the  error  integrator  outputs  wll  be  as  shown  below. 
Assuming  drift  rate  derivatives  -*■  0, 


J20 


J30 


E2  + 


E3  + 


[K.P  + w K.P  + w B,]  n 
Z Q Z o 3 

A(P) 

[K-P2  + (B.-OJ  K_)P]  n 
3 3 o 2 

A(P) 


(P) 


P + K.P  + a)  (K-+0)  ) P + on  B. 
2 O 3 O O 3 
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3 . 4 The  Inter -Update  Period 


In  order  to  investigate  the  operation  of  the  inertial  systems  between 
updates,  that  is  when  the  optical  sensors  are  disconnected-  We  need  only 
consider  inertial  system  (1) . 

As  we  are  considering  the  inter-update  period,  then  it  is  not  unreason- 
able to  expect  the  composite  gyro  drift  terms  to  be  nulled  by  the  integrators 
in  the  optical  sensor  path.  In  this  case  the  linearized  equations  of  motion 
reduce  to: 


E dt  = 

E10 

~ WoE3  + 

WoE30 

E20 

+ “oE2  - 

“oE20  = 

E30 

Solving  for  the  error  integrator  outputs. 
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E 
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20 

30 


E 

E 

E 


1 

2 

3 


This  highly  desirable  result  is  brought  about  by  reproducing  the  kinematic 
cross  coupling  within  the  inertial  system  configuration. 
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3 . 5 Gyro  System  Update 


The  justification  for  the  highly  redundant  gyro  system  proposed  is  the 
assumption  that  the  satellite  will  be  attacked  in  a manner  which  will  damage 
the  optical  sensors  but  not  the  gyro  system,  which  is  assumed  to  be  adequately 
shielded  by  the  satellite  body.  If  this  scenario  is  accepted  then  the  gyro 
system  must  be  erected  and  operational  at  all  times,  and  it  must  be  shown,  as 
I think  it  has  been,  that  the  gyro  system  has  a high  probability  of  remaining 
operational  for  the  projected  life  of  the  satellite.  Furthermore,  any  method 
used  to  update  the  gyros  from  the  optical  sensors  must  be  one  which  has  a very 
low  probability  of  de-erecting  the  gyro  system  in  the  event  that  the  optical 
sensors  are  destroyed.  Referring  to  Fig.  8,  the  update  switches  open  or  close 
the  connection  between  the  optical  sensors  and  the  gyro  system.  It  is  intended 
that  this  connection  will  be  made  when  updating  is  required  and  broken  only 
when  updating  is  deemed  to  be  complete. 

The  update  period,  when  the  connection  is  made,  is  likely  to  be  a very 
small  percentage  of  the  total  time.  A high  quality  inertial  grade  gyro  such 
as  the  TGG  or  G1-K7G,  properly  compensated,  can  be  expected  to  remain  erected 
within  the  pointing  tolerance  for  several  months  when  operated  in  a zero 
acceleration  environment.  Whereas  updating,  when  required,  will  occupy  a f ew 
minutes.  Furthermore,  the  method  of  drift  correction  suggested  for  Inertial 
System  (1)  is  inherently  error  free.  So  infrequent  is  updating  likely  to  be 
that  consideration  must  be  given  to  operating  the  update  switches  manually  by 
ground  command. 

However,  other  considerations  may  indicate  the  desirability  of  an  auto- 
matic system  which  is  therefore  discussed  below. 

Update  Algorithm 

Any  automatic  method  of  operating  the  update  switches  must  make  the 
following  decisions. 
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1.  Is  an  update  required? 

2.  Is  an  update  complete? 

3.  Is  the  optical  sensor  output  valid? 


The  algorithm  will  not  attempt  to  judge  gyro  validity.  This  is  a quite  sep- 
arate problem  which  can  also  be  automated  to  some  limited  extent;  however,  in 
the  interests  of  simplicity  and  reliability,  it  is  recommended  that  this  func- 


by ground  control. 

Condition  (1) 

In  general  a gyro  update  will  be  required  whenever  the  optical 
sensor  error  angle  no  longer  equals  the  output  of  the  gyro  system  error  inte- 
grator. However,  optical  sensor  noise  together  with  gyro  short  term  random 
drift  rates  will  insure  that  this  is  always  true.  Fortunately  our  concern  is 
with  relatively  long  term  (several  hours)  changes  in  gyro  drift  rate  bias.  It 
will  therefore  be  possible  to  average  this  difference  over  some  long  period, 


T = programmable  averaging  period 
Eqs  = Optical  Sensor  Output 
Eio  = Gyro  Error  Integrator  Output 

Condition  (2) 

Condition  (2)  follows  directly  from  (1).  If  the  optical  sensor 


output  error  angle  is  equal  to  the  gyro  system  error  integrator  output,  then 
irrespective  of  body  rates,  the  gyro  is  erected. 


tion  be  performed  by  multi-sensor  observation  followed  by  appropriate  action 


t=T 


(E  -E.  )t  > |0.1° I 

OS  lo  1 1 


(1) 


t=o 


t=T 


t=o 


(E  -E.  ) t < 1 0.01° I 
os  io  1 1 


(2) 


34 


Condition  (3) 


This  condition  overrides  the  previous  two,  and  is  the  most  dif- 


ficult to  mechanize.  It  does,  however,  divide  into  two  distinct  areas,  the 
gross  operation  of  the  optical  sensor  and  the  characteristics  of  the  output 
signal . 

The  gross  operation  is  simply  the  measurement  of  the  various  characteristic 
waveforms,  voltages  and  currents,  etc.,  which  would  characterize  a normally 
operating  and  appropriately  stimulated  optical  sensor.  The  output  character- 
istic measurement  would  be  an  attempt  to  detect  gross  changes  in  the  noise 
envelope  by  measurement  of  threshold  crossing  rates.  This  would  involve  the 
establishment  of  two  symmetrical  amplitude  thresholds  centered  about  the 
average  sensor  output.  The  mean  rate  of  threshold  crossing  would  be  measured 
on  a continuous  basis  and  compared  with  stored  programmable  norms.  If  we 
assume  a Gaussian  distribution  for  the  noise  this  method  would  be  very  sensi- 
tive to  changes  in  RMS  noise  level.  It  would  also  detect,  as  noise,  random 
departures  from  the  mean  level  due  to  other  sensor  malfunctions.  This  method 
would  assume  that  the  change  of  sensor  error  would  be  very  small  during  the 
averaging  time.  During  normal  operation  this  would  be  true. 


t=T 


H, 


T 


t=o 


t=T 


H 


L 


t=o 


Mean  Expected  Time 


H , H = absolute  amplitude  of  high  and  low  threshold  respectively 

X Xj 


Kr,  = programmable  high  and  low  thresholds 


3 = system  bandwidth 
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The  algorithm  conditions  are  summarized  below. 


i t=T 

± Y (E  -E.  )t  > |0.1°| 
T ^ os  io  1 1 

t=o 


Envelope  True 


> 


Update  Loop 
Close 


(1) 


Envelope  True 


> Loop  Open 
(override) 


(2) 


The  foregoing  has  outlined  the  system  configuration  and  analyzed  in  a 
general  way  the  three  major  attitude  sensing  arrangements.  The  gyro  instru- 
ment tentatively  suggested  for  the  HEXAD,  the  Northrop  G1-K7G,  is  probably 
the  most  mature  and  documented  inertial  grade  instrument  presently  available, 
and  as  such  is  able  to  provide  hard  reliability  data.  However,  the  two  axis 
ESG  presently  under  development  by  Honeywell  and  Autonetics  has  a theoretical 
MTBF  limited  largely  by  the  electronics.  This  clearly  suggests  a reliability 
potential  considerably  in  excess  of  present  instruments.  The  ESG  must  therefore 
be  considered  a very  strong  contender  for  the  gyro  system  instrument. 
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I'll- : CCMP4  FORTRAN  A 6/16/77  15:33  M.I.T.  LINCOLN  LABORATORY 


C WB  SMIIH  IE  SI  NOBDSIECK  INTEGRATION  BOUTINE 
C 

C BAIN  PROGRAM  FOB  DYNAMIC  SIMULATION  BOUTINE.  INITIALIZATION  AND 

C SPECIFICATION  OF  INTEGRAL  PABAMETERS  IS  PERFORMED. 

C 

IMPLICIT  R EAL*  8 (A-H,0-Z) 

CCMMON/ADAMS/DYDT  (180 ,15)  , DYDTO (1 80)  , N PR EDT, NCOK FT , N EQ , NH 
1 , INT FMX, ITYPE 

COMMON/INCON/HC, HMX,HKN ,EPS, T,  N,M ,L1 
COMMON/S1INT/VO  (180)  ,1’0,TSTCP 

CCMMON/NMSTP.T/AO  ( IbO)  ,30(180)  ,C0 ( 1 80)  , DO  (1 80)  ,EE0  (180)  ,HS AVE, 

1 DOTH  ,.BCIH  , N S I (>  N ,F0  (180) 

COMMON  /TORQ/IE1, ID2,TD3 


I T Y t E = 1 

NUMBER  CF  D.E.  EQUATIONS 

M = 1 1 

N = 1 1 

I I =C 

F C = 1C . DO 

MINIMUM  STEF  SIZF 
K K N = 1 . L - 4 
T INITIAL 
IC=C.  i;0 
1 FINAL 

1 JTCP  = 2 4 . U L' C*  36CC  .DO 
N S IG  N = 1 

MAXIMUM  STEF  SIZE 

hmx-1  . DO 

£FS= 1 . c-e 

INITIALIZATION  OF  INTEGRALS 

DC  100  I?  1 , N 
VC (1 ) =0  .DC 

V0 (7)  =- 1C0j .0L0/28.D0 

ICRvUES  ARE  ENTERED 
C 

4FITE  (2,1) 

1 FORMAT  (•  INPUT  TCRQS  IN  MICRC-FT . LBS. • ) 

E F AD  (2,*)  TD1,TD2,TD3 
1L  1 = TD 1* 1 . D-6 
U2  = 1C2*1  . D-b 
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B ILE: 


C 

C 

C 


C 

c 

c 

c 

c 


c 


c 

c 

c 

10 

c 

c 

c 

c 

c 
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c 

c 

c 


c 

c 

c 

20 

c 

c 

c 
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CC  Mp4  FORTRAN  a 6/16/77  15:33  M.I.T.  LINCOLN  LABOR A TOP  Y 


TLj  = TL'3*1.D-6 


CALL  TC  INTEGRATION  ROUTINE 

CALL  NUNINT 
ELD 


COfUUTAIION  OF  DERIVATIVES  IS  PERFORMED  IN  THE  FUNCTION  FN 

DOUBLE  PRECISION  FUNCTION  FN(K,J,S) 

I Mil  C II  R E AL  * 8 (A-H,0-Z) 

PEAL* 8 UG/7 2 • 72 20 51 2 1 7 D-6/, J 1/280 0. DO/, J 2/280 C . CO/, J 3/ 2800. DO/ 
E i AL*  8 112  0/ 49. 571-6/ 

PE AL*8  Kl/c80.DG/,K2/280. DC/,  K 3/2 80. DO/ 
hE  AL*b  K1/28  0.DC/,K2/O.DO/,K3/C.DO/ 

REAL* 8 El/28. D0/,E2/28. C0/,B3/28.  DO/ 

PEAL* 8 £1/28. DO/, E2/0. DO/, B3/C .DO/ 

RE A 1*8  KT/0.0L0/,K11/1. D0/,K2//1.  DO/, K 33/1. DO/ 

PEAL* 8 K4/C.DC/,K5/1.D0/,K6/1 .DO/ 

COMMON /CUTFUT/K1CUT, K20UT,V ( 1 80, 4 J , F ( 1 80 , 3) 

CCMMON/STINT/VO ( 16C)  ,T0,T3TOP 
COMMON  /TOEQ/TD1 ,TL2#TD3 
COMMON  /XTEPMS/H1 ,H2, H3 
COMMON/INCON/HC,HMX,HMN,EPSfT, N, M, LI 

IHE  VARIABLE  K SELECTS  THE  DEEIVATIVE  TO  BE  COMPUTED 

GO  TO  {10, 2C, 30, 4 0,50, 60,70, 8 0,90, 100,  110)  ,K 
CONTINUE 

THE  VALUES  OF  Hi,  H2,  AND  H3  ARE  COMPUIED 

H1=-K1*K11*V(1,J) -E1*K11*V (7,J) 

H<:  = -K2*K22*V  (2  , J)  - E2 * K22*V (8 , J) 

H2  = -KJ3*  {K3*V  {3  , J)  +B3*V  (9,  J)  ) - KT*V  (10,  J)  /J2 

H 1 =C. DO 
H2  = 0 . DO 
F3=C. LG 

El  IS  CCMPUTEL  EROM  DE1/DT 

F N=  V (4,  J) 

GC  10  6CC 

E2  IS  COMPUTED  FnCM  DE2/CT 

F N = V {5, J) 

GC  TO  6CC 

E2  IS  COMPUTED  FROM  DE3/DT 

F N = V (6,0) 

GC  TO  600 
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FILE:  COM  P4 


FORTRAN  A 


6/16/77  15:33 


M.I.T.  LINCOLN  LABORATORY 


C 

C CF1/D1  IS  COMPUTED 

C 

4 C f N = (-1  3“  V ( 3 , J ) ♦ K2  * (WO*  (V  (2  , J)  "K6  + V (3,  J ) ) + V (6, J)  ) 

* +TD1*CSIN  (W0*T)-V(4,J)*K1-V(1,J)*B1)/J1 

GC  10  600 
C 

C DL2/DT  IS  COMPUTED 

C 

5C  FI.  = (WC»  ( (G2-J1  + 03  ) *V  (6  , J)  - (J1  - J3)  *WO*V  (2,  J)  ) 

* -HI*  (V  (6  , J ) + WO*  V J ) *K6)  +H3’'  ( V ( 4 , J)  + WO*  K 5) 

* +102*0 SIN (KC* (1) ) -V (5, J) *Ki-V (2,J) *B2) /J2 
C * ♦TD2-V  <5,J)*K2-V  (2,J)*B2)/J2 

GC  TO  bOC 
o 

0 EE3/LT  IS  COMPUTED 

C 

60  f N = ('*0*  ( (J2-J1+J3)  * V (5,  J)  - (J2-J1 ) * WO*  V (3,  J)  ) 

* -H2*  (V  (4  , J)  + WC  » K 5)  + H1*  (V  (5,  J)  -W0*V  (3,  J)  ) 

0 * + W3*  (V  (11,  J)  + H2) -HI*  (V  (11  ,J)  ♦ '12) /J2 

* + 1D3+DCC3  (WO* (T)  ) -V (u, J) »K3*K4-V  (3, J)  *E3*K4) /J3 
C * +T03-V  (6,  J)*K3*K4-V  ( 3 , J)  * S3  * K4)  / J3 

G C TO  b 0 C 
C 

C THE  INTEGRAL  OF  El  IS  COMPUTED 

C 

7 0 F N = V ( 1 , J ) 

(>  0 10  o 0 C 

c 

C THE  INTEGRAL  CF  IS  COMPUTED 

0 

ec  rasv(2,j) 

c-c  TO  oCC 

c 

0 THE  INTEGRAL  OF  E3  IS  COMPUTE!' 

C 

30  r N = V ( J , J) 

GC  TO  6 0 C 
C 

C THE  INTEGRAL  CF  U1*H2  IS  COMPUTED 

o 

ICC  F N = H 1 * H 2 

C-C  TO  6 CO 
C 

0 THE  INTEGRAL  CF  TD20  IS  COMPUTED 

C 

110  CONTINUE 

C FN  = ID2C*DSIN  (WO*  (I) ) 

FN=ID20 
C F N= ID2 

600  CONTINUE 

C WRITE  (2,*)  K , J , V (K, J) 

RETURN 

END 

C 
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t:  c n r k,  o n o n o n o 


FI LE:  CCKP4 


FCETRAN  A 


6/16/77  15:33 


M.I.T.  LINCOLN  LABORATORY 


lii E OUIfUT  FILE  IS  CREATES  BY  THE  SUBROUTINE  GIVOUT 

SUBROUTINE  GIVOUT 
IMPLICIT  FFAL*8  (A-H,0-2) 

INTEGER  ICNT/0/ 

FEAL*6  wO/72. 722041217D-6/ 

CCRKCN/INCCN/HC  ,HRX,HRN,ErS,T, N,M,L1 
CCMtlON/CUTPUT/K  1 , K2, V ( 1 80, 4)  ,F(180,3) 

CORDON/ STINT/ VC  (180)  ,T0,TSTCP 
CCMrtON  /XTERMS/H1  ,H2, H3 
CCRRCN  /IORt/IDI , IC2,TC3 
ICNi?ICNT+1 

IT  (IcNT.GT.1uCC)  GO  TO  100 
ICRC  1=1 E 1 

TCRQ2  = ID2*CSIN  (W3*  (T) ) 

TCFC3=TI3*CC0S  ( W C * (T)  ) 

LATA  IS  wlilTTcN  TO  OUTPUT  FILE 

WRITE  (10,2)  T,  (V  (1,3)  ,1  = 1,6)  , TORQ1 , TORQ2  , TCRQ3 
FOR- AT  (10  Ab) 

IF  (oO-  (IlNT/dO)  . ZQ. ICNT)  WRITE  (2,*)  ICNT,T 
WRITE  (2,*)  ICNT  , T 
WP1IE  (2,2)  T,  (V  (I, 3), 1=1, 10) 

WRITE  (2,4)  H 1 , H 2 , H 3 
FCRRAT  (1 X ,3  (IX  ,F  10. 3) ) 

3 FCRHAT  (1X,F1C.2,  1C { IX, F10. 4)  ) 

1 FCRRAT  (8  (1 X, C15. 4) ) 

PtTUSN 

ICC  WTITE  (2,1)  I,HC,  (V  (I,  3)  ,1=1,  10) 

STCF 

END 
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20.  ABSTRACT  (Continue  on  reverse  side  if  necessary  and  identify  by  block  number) 


The  proposed  attitude  control  system  addresses  three  principal  problem 
areas: 


(1)  Operation  within  a high  disturbance  torque  environment, 

(2)  The  preservation  of  vehicle  attitude  in  the  event  that  the  op- 
tical attitude  sensors  are  destroyed  by  external  means,  and 

(3)  System  operational  longevity. 
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